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NONLINEAR CONTROL OF SPACE MANIPULATORS WITH MODEL UNCERTAINTY 


Abstract 

Nonlinear control using feedback linearization or inverse dynamics for robotic manipulators yields good results 
in the absence of modeling uncertainty. However, modeling uncertainties due to unknown joint friction coefficients 
and payload variations can give rise to undesirable characteristics when these control systems are implemented. In 
this work, it is shown how passivity concepts can be used to supplement the feedback linearization control design 
technique, in order to make it robust with respect to the uncertain effects mentioned above. Results are obtained for 
space manipulators with freely floating base; however, they are applicable to fixed base manipulators as well. The 
controller guarantees asymptotic tracking of the joint variables. Closed-loop simulation results are illustrated for 
planar space manipulators for cases where uncertainty exists in friction modeling and payload inertial parameters. 


1 Introduction 


The dynamics of space manipulators differs from that of fixed base manipulators since their base is free to 
move. The base could be either a spacecraft or a satellite. The movement of manipulator arms produces reaction 
forces and torques on the base. Therefore the resulting motion of the base has to be accounted for in the dynamic 
model for the manipulator. However, Papadopoulos and Dubowsky 1 showed that a dynamic model for space 
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manipulators with a free base is similar in structure to the dynamic model for fixed base manipulators. An obvious 
similarity is that the inertia matrix in each case is symmetric and positive definite. In fact, the dynamic model for 
fixed base manipulators can be viewed as forming a subset of that for space manipulators. 

Some concepts have been proposed for joint trajectory control and inertial end tip motion control of space 
manipulators. Vafa and Dubowsky 2 developed an analytical tool for space manipulators, known as the virtual 
manipulator concept The virtual manipulator is an idealized kinematic chain connecting its base, the virtual base, to 
any point on the real manipulator. This point can be chosen to be the manipulator's end effector, while the virtual 
base is located at the system center of mass, which is fixed in inertial space. As the real manipulator moves, the end 
of the virtual manipulator remains coincident with the selected point on the real manipulator. Additionally, it can be 
shown that the change in orientation in the virtual manipulator’s joints is equal to the change in the orientation of the 
real manipulator’s joints. While these features give the designer the ability to represent a free floating space 
manipulator by a simpler system whose base is fixed in inertial space, the associated transformation depends on 
knowing the system parameters exactly. Alexander and Cannon 3 showed that the end tip of the space robot can be 
controlled by solving the inverse dynamics that includes motion of the base. Their method assumes the mass of the 
spacecraft to be relatively large compared to that of the manipulator it carries, and also requires much computational 
effort to determine the control input. Note that some future space systems are expected to have the manipulator and 
spacecraft masses of the same order. Umetani and Yoshida 4 proposed the generalized Jacobian matrix that relates 
the end tip velocities to the joint velocities by taking into account the motion of the base. However, robustness of 
the control scheme with respect to modeling uncertainties is not discussed. Masutani et. al . 5 proposed a sensory 
feedback control scheme based on an artificial potential defined in the sensor coordinate frame. This scheme is 
based on proportional feedback of errors in the end tip position and orientation as well as feedback of joint angular 
velocities. A robust controller based on feedback linearization using a simplified nonlinear model and passivity 
concepts was developed by Chuang, Mittal, and Juang*\ 

In this report a robust control scheme using feedback linearization of the complete model and passivity concepts 
is proposed for space manipulators in which joint friction and mass variations are considered. The proposed 
technique can be used for fixed base manipulators also. The control scheme uses inverse dynamics; however, it is 
robust in the face of bounded modeling uncertainties which might arise due to improper or absent friction modeling 
as well as payload variations. The controller asymptotically tracks prescribed time varying joint angle trajectories 
whose acceleration is bounded in the L 2 space. Although only two types of uncertain dynamic effects are 
considered here, the controller can be applied to systems with other types of uncertainty. 
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2 rwnamir.s nf Space Manipu lator Sys tem with Uncontrolled B ass 


This development of a nonlinear dynamical model for space manipulator systems whose base is uncontrolled is 
discussed in this Section. The development of the expressions for Unear and angular momenta of the system closely 
follows that given in Reference [5], however, the form of the final equations of motion is different A space 
manipulator system in the satellite orbit can be approximately considered to be floating in a non-gravitational 
environment. As shown in Figure 1, the manipulator and the base can be treated as a set of n+1 rigid bodies 
connected through n joints. The bodies are numbered from zero to n with the base being 0 and the end tip being n. 
Each joint is then numbered accordingly from one to n. The angular displacements of the joints can be represented 

by a joint vector, 

q = [q x q 2 -<l n ] T (1) 

The mass and inertia tensor of the 1 th body are denoted by mj and I i: and the inertia tensor is expressed in terms of 
the base frame coordinates. 

2.1 Kinematics 

A coordinate frame fixed to the oibit of the satelUte can be considered to be an inertial frame, denoted by Lp In 
addition to Li, another coordinate frame I B is defined that is attached to the base with its origin located at the base 
center of mass. The attitude of the base itself is given by roll, pitch, and yaw angles. In the sequel, all vectors are 
expressed in the base fixed coordinate axes. 

Let Ri and r; be the posiuon vectors of the center of mass of the i* link with respect to frames Li and Lb, 
respectively. Then 


Ri = R B + w 

where R B is the posiuon vector from the base center of mass to the origin of the frame Lp Let Vi and £2i be the 
linear and angular velocities of the center of mass of the 1 th Unk with respect to frame Li and v; and o>i be the linear 
and angular velocities of the same point with respect to frame L B . Then Vi and Qi can be written as 

Vj = Vb + vj + Q B x ri ( 3 ) 

£2j = + (Dj 
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Vb and Qb are the linear and angular velocities of the base center of mass with respect to frame Zj. Note that for 
any space manipulator, v; and (Oj for each link can be represented by the following forms 


Vi = JuWq 

= JAi(q)q 


where JLi(q) and JAj(q) e R 3xn are the Jacobian matrices for the i* link. 

The position of the system center of mass with respect to the base frame depends on the joint angles, 
below are two measures related to the system center of mass. 



r c (q)= 


X m i r i(q) 


i=0 



2.2 Linear and Angular Momenta 

The linear momentum P and the angular momentum L of the whole system are defined as follows 


P= ImiVi 

i=0 


L = IpA + roiRjXVi] 

i=0 


Substituting Equations (2) through (8) into Equations (9) and (10) yields 

P = H v V B + H vQ Q b + H v<1 q 

L = Hj 0 V B + H a £2 B + q + Rfl 


where 

H v = m c I, H v e R 3x3 

H v o = -m c [r c x], H yQ eR M 


(5) 

( 6 ) 

Given 

(7) 

( 8 ) 

(9) 

( 10 ) 

(ID 

( 12 ) 

(13) 

(14) 
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(15) 


Hyq H vq eR 

i=l 


3xn 


H n =XIi + inii[r i x] [rjx], H 0 eR 


3x3 


i=0 i=l 


H o q = i( I i J A i + m i [ r i x]j u }, H Qq eR 3xn 


(16) 

(17) 


Also, for any vector 


[f x] is defined as follows 


f = 


U 

h . 

*3- 


[fx]» 



— ^ 3 
0 

f. 



(18) 


(19) 


and I is an identity matrix of appropriate dimensions. 


Since the working environment is non-gravitational and no actuators generating external forces are employed, 
the linear and angular momenta of the whole system are conserved. Since the inertial frame is fixed to the orbit, the 
whole system can be assumed to be stationary with respect to the inertial frame at the initial state. Thus the above 
two momenta are always zero for the whole system. Note that it is implicitly implied that the satellite is a non- 
spinning body. By using the fact then that the linear and angular momenta are zero. Equations (1 1) and (12) result in 


V B =-H; 1 [H vQ £2 B + Hv,q] 

(20) 

fl B = -[Hq - hJqH^Hvq] [Hq,, - H voHv H^jq 

(21) 

2 3 Manipulator Dynamics 

The total kinetic energy of the space robot can be written as 


T=H(m i vTv i +n7iA) 

2i=o 

(22) 


Page 6 


Using Equations (3) through (8) and (13) through (17) the kinetic energy can be expressed as 



H v 

h vQ 

H vq ' 

V 

H la 


Ha, 

n B 

|hJ, 

< 


. q . 


( 23 ) 


where Hq is the inertia matrix corresponding to the fixed base manipulator 



(24) 


Equation (23) for the system kinetic energy can be simplified as follows. Substituting for Vb from Equation (20) 
leads to 

T=^QjMft B + Q^Zq + ^q T Wq (25) 


where 


m = h q -h3 q h; 1 h vQ . M e R 3 * 3 

(26) 

Z = H flq -Hj Q H; 1 H vq , Ze R 3 ™ 

(27) 

W = H q -H^H; 1 H vq , WeR™ 

(28) 

Further, substituting for fig from Equation (21), one obtains an expression 
terms of the joint variables 

for the system kinetic energy solely in 

T = -^q T D(q)q, DeR n * n 

(29) 

where D is the inertia matrix of the system and is given by 


D = W-Z t M _1 Z 

(30) 
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It can be shown that D = D T > 0. It is interesting to note that the system inertia matrix obtained in Reference [1] is 
of the same form as the above. However, the expressions for W, M, and Z matrices are different. This is because a 
different approach, viz. the concept of barycenlers, is used in the model derivation of Reference [1]. 

Since there is no potential energy in non-gravitational environment, the Lagrangian A, is equal to the kinetic 
energy 

A = T < 31 > 


So the system dynamics is given by 


d_r3A > |_aA =T (32) 

dt ^ 3q J 3q 


where x is an nxl vector of joint torques. The equations of motion for space manipulators can then be written as 

D(q)q + h(q,q) = x ( 


where 


h(q.q) = C(q,q)q + Tf 


(34) 


Paralleling the development for fixed base robots given by Spong and Vidyasagar 7 , the elements of the matrix C are 
obtained as 




dPtj t dDki 
3q s 3qj 



(35) 


and if represents the joint torque vector due to friction. As pointed out by Craig 8 , the total friction at each joint can 
be taken to be the sum of Coulomb friction and viscous friction. Coulomb friction is constant except for a sign 
dependence on the joint velocity. Viscous friction, in general, depends on various powers of joint velocity. 
However, higher powers contribute significantly only at high joint velocities. Manipulators usually do not attain 
such high velocities. Therefore, it is sufficient to consider only the linear dependence of viscous friction on joint 
velocity. Figure 2 shows a friction model consisting of Coulomb friction and linear viscous friction. Using this 
model, the joint friction torque vector can be represented as 
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T f = 'Psgn(q) + fq 


(36) 


where ¥ is a diagonal matrix consisting of Coulomb friction constants for the joints, and T is a diagonal matrix 
consisting of viscous friction coefficients for the manipulator joints. It turns out that in many manipulator joints, 
friction also displays a dependence on joint position. However, such effects are not considered here. There are 
other effects like bending effects that are difficult to model and also neglected in the present model. 


2.4 Base Motion 

The translational velocity of the base center of mass can be written in terms of joint velocities by using the 
expression for Qg from Equation (21) in Equation (20). 

V B =-H; 1 [H vq -H^M-'zJq ( 37 ) 


Also, the base angular velocity from Equation (21) is 

Q B =— M _1 Zq 


(38) 


Using the above expressions, the evolution of the base position and orientation with time can be determined as 
follows 


*b" 


1 

O 

< 

o 

o 

CyS^S^ SyC^ 

C y SqC ^ + SyS^ 

h 

= 

SyCg 

SySgS^ CyC^ 

SyS 0 C* “ CyS^ 

.Zb. 


_S 0 

c e s + 

c «c* 


(39) 


V 


1 s + tan(0) c 4 tan(0) 

6 

= 

0 c + -s + 

¥ 


0 s^sec(0) Cy sec(0) 


(40) 


where c { .) = cos(-) , s ( ) = sin(-) . 


3. Control S ystem Design 

Assuming that the dynamics of the space manipulator is described by Equation (33), where D and h are 
completely known, the feedback linearization or inverse dynamics 7 technique can be used to design controllers for 
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tracking prescribed command trajectories for the joint angles. This can be accomplished as outlined in the following 
sub-section. 


3.1 Feedback Linearization 

Let the joint torque vector be of the following form. 


x = Du + h 


(41) 


where u is the pseudo-control, i.e., it is the control input to the resulting linearized system. With the control law 
given by Equation (41), the closed-loop system becomes 


q" 

q. 



+ Bu 


(42) 


where 


A = 


0 I' 

0 0 


.B = 


0 

I 


(43) 


A simple PD (Proportional-Derivative) type of control law is chosen for the feedback linearized system 

u = q d +K 2 (q d -q)+K,(q d -q) t 44 ) 

where Kq and K 2 are proportional and derivative gain matrices, respectively. These matrices are usually chosen to 
be diagonal in order to achieve decoupled response among the joint angles. Substituting for u from Equation (44) 
into Equation (42), one obtains 


where e - [ej ejf.e, , e, - q. A, = A-BK. ahd K w[K, Kj. If K, > 0 and K 2 > 0. the era>r 

dynamics as given by Equation (45) is asymptotically stable. Tbe freedom in selecting the gain matrices can be 
utilized to meet performance specifications for the closed-loop system. 

The preceding discussion assumes availability of perfect knowledge about the nonlinear system dynamics. 
However, in practice, D and h are usually imprecisely known due to modeling inaccuracies. It is assumed that the 
controller is designed using best estimates for friction models and for a nominal value of the end-tip payload. The 
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actual joint friction will be different from that assumed in controller design, and the actual tasks might require 
handling a variety of payloads. Thus the controller uses computed versions of D and h. The objective here is to 
design a control law that is robust for bounded variations in D and h due to the uncertain dynamic effects in friction 
and payload. This issue of robust control design is discussed in the following sub-section, where it will be seen that 
the control law results in closed-loop asymptotic tracking. 

3 2 Robust Feedback Lineariz ation Using Passivity 

In the presence of modeling uncertainties, the control law is given as 

x = D c u + h c ( 46 ) 

where D c and 1^ are computed versions of D and h respectively. Substituting for x and u from Equations (46) and 
(44) into Equation (33) it can be shown that the closed-loop system dynamics is given by 

e = A c e+Bv (47) 


where 


v = Au + 5 


(48) 


and 


A = [l-D -1 D C ], 8 = D -1 [h-h c ] (49) 

The first step in the proposed design is to choose the gain matrix K = [K, K 2 ] and an output matrix F such that 
the linear system given by 


e = A c e + Bv 
y=Fe 


(50) 


is SPR (Strictly Positive Real). This can be achieved as outlined in the following theorem. A definition of the 
concept of Strictly Positive Realness can be found in Slotine and Li 9 . 

Theorem 1 [10]. Let Kj and K2 be such that 
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K t = diag[k n ]; k u >0, i = l n 

K 2 = diag[k 2i ]; k 2i >0, i = l,...,n 


( 51 ) 


(k 2 i) 2 >kii, i = l " 

then if F = K, the system described by Equation (50) is SPR. 

Nok that the conditions of the Theorem as prescribed by (5 1) are extremely easy to satisfy. 

With the linear System (50) being SPR. the Passivity Theorem" can boused to design asymptotically stable 
controllers as shown in the Mowing theorem. The notation ^ = (V**) is nred in the sequel. 

Theorem 2. Le, the desired trajectory fo, joint variables be such that q d c I?. Further, in die control law given by 
Equation (46), let h c be such that 

|D-'[l.-h t § T £c|u| T +d VT>0 <c20.~>d5f» (52) 


If D c is chosen such that 


D _1 D c £arI (a>0, r>0) 


(53) 


where 

c + 1 (54) 

a> v 

r 


then the closed-loop System (47) is asymptotically stable. 


Proof. The closed-loop system as given by Equation (47) can be represented in block diagram form as shown in 
Figure 3. It is first shown that the nonlinear block in the feedback path is passive 1 1 . Consider 

I = ]-u T vdt (T > 0) 

0 

T 

= J-u T (Au + 5)dt 
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( 55 ) 



Let the first and second integrals on the right hand side be denoted by Ii and I 2 respectively. Then 

I 1= |u T [D _I D c -l]udt ( 56 ) 

0 L 

Moling that Inequality (53) gives rise to D”'D e - 1 2 (ar - 1)1 , Equation (56) can be used to obtain the following. 

1, 2(ar-l)|u£ < 57 > 


On the other hand, 


-I 2 = Ju t D '[h-h c ]dt 
o 

< |u|| T |d _ 1 [h - h c ]| T (Holder’ s Inequality) 

< |u|| T [cUuU T + d] (Inequality (52)) 


Hence 


I>(ar-c-l)lu||^-d|]u|| T = f(|u|| T ) 


(59) 


It can be shown that if (ar - c - 1) > 0, then 


f(Mr)*- 


4(ar - c - 1) 


VH^O 


(60) 


which in turn would imply 


* T d 

}-u T vdt>- — - 

J 0 4(ar-c-l) 


VT>0 


(61) 


Thus a sufficient condition for the nonlinear block to be passive is that a > (c + l)/r. 

Additionally, the transfer function of the feedforward block [Ac, B, K] is proper and has no poles on the 
imaginary axis. Hence it has finite gain* 2 . Since q d e L 2 , then using the Passivity Theorem 11 , one can conclude 
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lhat the signals u, Ke, and v are bounded. Moreover, since the feedforward block is SPR, Ke(t) = K ie ,(t) + KjPaft) 
goes to zero asymptotically. This in turn implies that e,(t) and e^t) individually approach zero asymptotically 8 . 

Remark. The conventional method of designing robust controllers for robotics problems involves introducing an 
outer loop control 7 in order to compensate for the uncertain dynamic effects. This has been known to introduce 
chattering in the control. When the design method is modified to make the control smooth, closed-loop asymptotic 
tracking is generally compromised to some extent. In the method proposed in Theorem 2, an outer loop control is 
not employed. Instead, achievement of robustness can be qualitatively understood as follows. Depending on the 
amount of uncertainty contained in h, the computed version of the inertia matrix D, is modified such that conditions 
(53) and (54) of the Theorem are satisfied. 

The results of the Theorem are applicable to space manipulators as well as fixed base manipulators. Finally, it 
should be noted that the control design obtained using the results of the theorem is not unique. Additionally, there is 
a considerable amount of margin for performance optimization. 


4 Simulation Results 

As an example, results of applying Theorems 1 and 2 in order to achieve a robust control design will be 
illustrated for planar space robots. Nonlinear dynamic models for the robots are obtained using the results of Section 
2. The controller is designed for nominal values of joint friction coefficients and payload mass; whereas the actual 
robot will be considered to have variations in these. Simulation is carried out using variable-step fourth and fifth- 
order Runge-Kutta methods. The base and link masses in the following examples are assumed to be of the same 
order of magnitude. Closed-loop results are generated for step command to the joint angles. Note that in general, 
for end tip motion control in the inertial space, the inverse kinematics problem needs to be solved in order to 
generate a command trajectory for the joint angle vector. 

4.1 Planar One Link Snace Manipulator 

Figure 4 shows a planar one link space robot. Equation (33) describes the dynamics of this one degree of 
freedom system. The system inertia, computed using Equation (30), turns out to be 

D(q, ) = Wj j - Z j ! / M 3 3 (66) 

where 

W u = m 01 p?+I, (67) 
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^3,i — nioiPi (PoCi + Pi ) ^1 


( 68 ) 


M 3,3 = m Ol(P0 + P? +2p oPl C 1 )+I 0 + I l 


(69) 


Using Equations (34) and (35), h is determined to be 

h( <li > 9i ) = [rn 01 Po (Po + Pi c i ) + 1 0 ] ' [ m oiPi (Po c i + Pi) + Ii + VSgnCQi ) + 1 (70) 

M 33 

where v and y are respectively the coefficients of Coulomb and viscous friction. In Equations (67) through (70) 
m 01 = m 0 m 1 /m c , m c = mo + m lt c, * cos(q,). and s, * sin(q,). Hie quantifies m lt I b and pi are defined for an 

“equivalent” link that is obtained by removal of the end tip payload and absorbing its inertial characteristics in those 
of the link itself. The concept of the equivalent link is explained in the Appendix. 

It can be seen easily that as m 0 ->» and I 0 -» 00 . 

D — » mjpJ + Ij, h-nysgn^ + Tqi ( 71 ) 


which represents the case of a fixed base manipulator. Equation (39) is used to determine the evolution of the base 
position with time 


Xk = 


_m 1 


m r 


Pi s vi"^( p o s v + Pi s vi) 

M 3,3 


Hi 


m 


Yb = 


m r 


-Pl C Vl + J' (p° C V + 


a? 

M 33 


Pl c *l) 


Qi 


(72) 


where s yl S sin(y + q, ), c yl - cos(i|r + q,) . Finally, the base attitude dynamics is obtained using Equation (40) 


Z3 1 • 

V= -Tf-* 

M 3i 3 


(73) 


Next, a feedback controUer is designed for the one Unk space manipulator using the results of Theorems 1 and 
2. D c and h c are obtained from Equations ( 66 ) and (70) respectively, by using the nominal values of end-link 

parameters and friction coefficients: 
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( 74 ) 

h c = h lm 1 -»m lc ,p 1 -»p lc ,I,-»Ii e .Y-»¥«.T-»T« 

Closed-loop results are generated for a step command of 1 radian to the joint angle. Table I lists physical parameters 
of the example robot used in simulation. The feedback gains are chosen to be ki = 0.4 and k 2 = 1.0. This choice of 
gains satisfies Conditions (51) and in case of no modeling uncertainty, yields a closed-loop response without any 
overshoot. Simulation results will be shown for the case in which there is no modeling uncertainty, and for another 
case that involves uncertainty. 

Figures 5 through 8 show closed-loop responses for the nominal case. Figure 5 shows that asymptotic tracking 
in the joint angle is achieved. Figures 7 and 8 show that the base moves in reaction to link motion; this is due to the 
conservation of linear and angular momenta as discussed in Section 2. However, the joint angle still achieves the 
appropriate commanded value. The closed-loop responses for the case involving uncertainty will be overlaid on 

Figures 5 through 8. 


5. Conclusions 

A robust control method based on feedback linearization and passivity concepts is proposed for space 
manipulators. The method is applicable to fixed base manipulators as well. The control law results in asymptotic 
joint angle tracking in the face of bounded uncertainties in friction modeling and payload inertial characteristics. 
For the first time, closed-loop simulation results will be presented using this control method. 
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A ppendix 

The concept of an equivalent link is described here. Following are two equivalent representations of the same 
link. The Figure on the left shows the actual link, while the one on the right shows a hypothetical equivalent link 
that is obtained by removal of the end tip payload and absorbing its inertial characteristics into the link. 
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Actual Link 



Equivalent Link 


The geometric and mass properties of the equivalent link are given as follows: 


nij = m ! + rn c 


m,p, + m e li 

Pi ! 

m, + m e 


• \2 


I^ii^llrp;)' 

mj+m,.' 
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Base Frame 



Figure 1 . A Space Robot 


Friction Torque 



Friction Model Consisting of Coulomb’s Friction and Linear Viscous Friction. 


9 








Base Position (m) Base Attitude (rad) Joint Torque (N-m) 
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Table I. Physical Parameters of Single Link Robot 


Body 

p (meter) 

1 (meter) 

m (kg) 

I (kg.m 2 ) 

0 (Base) 

3.0 

- 

5.0 

30.0 

1 (Link) 

3.0 

6.0 

1.0 

3.0 
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